Accurate Mapping And Planning For Autonomous Racing